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Abstract:-ln this paper, an efficient method to linearize dynamic models about a linear trajectory for two link 
robot manipulators is developed from "straightforward" Lagrangian formulation and implementation of LQR 
(Linear Quadratic Regulator). This method is very simple and systematic. It can be applied to compute the feed 
forward control law (i.e. generalized forces and torques) about the desired trajectory (i.e. defined robot task space) 
and to design the feedback controller that reduces or eliminates any deviations from the target object placed in a 
defined robot space task. The salient advantage of this method is that the robot along with its system complexities 
can track target very efficiently and can lift the specified object effectively at specific position and angle by 
minimizing the steady state error. Computationally it has been found that this method tracks the target in much 
lesser time. Moreover, this method is very cost effective and economic. 
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I. INTRODUCTION 

Robot manipulators exhibit structural flexibility. A nonlinear control law that incorporates manipulator dynamics 
as well as the application of an observer is developed in this paper. This technique is based on state feedback, output 
feedback along with a controller. The kinematics of the model represents the motion of the robot taking into considerations 
the forces which causes the motion. The robot manipulator operates in specified task space in which it moves along a 
specified direction and lifting the defined object at a specified angle. The model discussed here establishes a relation 
between force and torque taking into consideration the masses and moment of inertia. The different feedback used here 
shapes the local behavior of the system. The dynamics of the proposed model is a MIMO (Multiple Input Multiple Output) 
system. It is linearised and is expressed in state space model. The state of a dynamical system is basically a collection 
variables that permits the prediction of future development of the system. In this paper we explored the idea of controlling 
the system through feedback of the state. The feedback control is developed by positioning closed loop eigenvalues in 
desired locations. The state feedback actually stabilizes the system. We need the output feedback for tuning. If tuning is not 
done then we have to find the gain by trial. If only the output feedback is done response of the curve will be growing in 
nature and the plant will not be stabilized and as a consequence pole placement cannot be done. On the other hand if only 
state feedback is done desired performance may not be achieved. The results will come up with different errors such as 
steady state errors, overshoot, speed of response etc. Moreover, to make things desirable we use P/PI/PID controller so as to 
have the performance at requisite level. To use PID controller we have to use the connection from output to the input i.e. 
output feedback. Reduced order Das & Ghosal observer is implemented to measure the immeasurable states and to make the 
system sensor less. If sensor is used associated problems will be in costing and space allocation. Further use of observers 
eliminates the noise problems. Computer simulations are performed to verify the feasibility of robot manipulator along with 
the implemented observer. The experiments show that the proposed work produces good tracking performances in 
estimating the states yielding remarkably improved results.LQR is an elegant method for pole placement. Apart from LQR 
method for pole placement Ackermann's proposition is frequently used. But the drawback associated with this is that pole 
locations have to be chosen by trial and error method. But by LQR method pole placement policy is much easy to 
implement. Moreover it minimizes the control effort giving smart results. 

II. BRIEF THEORY ON ROBOTICS 

A robot system consists of - 

> Manipulator 

> Sensory Devices 

> Controller 

> Power Conversion Unit 

A. Manipulator: 

The Manipulator consists of a series of rigid members called Links connected by joints. Motion of a particular 
joint causes subsequent Links attached to it to move. The motion of a joint is accomplished by an actuator mechanism. The 

20~~ 



A Composite Robotic Controller Design Using Reduced Order Observer... 

actuator can be connected directly to the next Link or through some mechanical transmission. The Manipulator ends with a 
Link on which a tool can be mounted. The interface between the last Link and the tool or the end effectors is called Tool 
Mounting Plate or Tool Flange. 
The Manipulator itself may be thought of as being composed of three divisions: 

> The major Linkages 

> The minor Linkages 

> The end Effectors 

The manipulator is a collection of mechanical linkages connected by joints. The manipulator is capable of 
movement in various directions and is said to do "the work" of the robot. Generally the joints of the manipulator fall into two 
classes. The first, revolute joint produces pure rotary motion. Consequently the term rotary joint is often used to describe it. 
The second prismatic produces pure linear or translational motion and as a result it is often referred to as linear joint. Each 
joint of the robot defines a joint axis about or along which the particular link either rotates or slides (translates). Every joint 
axis defines a degree of freedom (DOF) so that the total number of DOF's is equal to the number of joints. The manipulator 
defined by joint-link structure generally contains three main structural elements: the arm, the wrist end the end effectors. 
Besides mechanical components most manipulators contain devices for producing the movement of various mechanical 
members. These devices are referred to as actuators and may be pneumatic, hydraulic or electrical in nature. They are 
invariably coupled to various to various mechanical links or joints (axes) of the arm either directly or indirectly. 




m 2 



B. Sensory Devices: 

These devices monitor position, speed, acceleration and torque. The sensor is connected to actuator shaft. However 
it could be coupled to the output of transmission 

C. Controller: 

The controller provides intelligence to cause the Manipulator to perform in a manner described by its user. 
Each controller consists of: 

> A memory to store data defining the position 

> A sequencer to interpret the data stored in memory 

> A computational unit 

> An interface to obtain the sensory data into the sequencer 

> An interface to transfer sequencer information to the power conversion unit 

> An interface to ancillary equipment 

D. Power conversion Unit: 

This unit contains components required to take a signal from sequencer and convert it to the meaningful power 
level so that actuators can move. 

III. DYNAMIC MODEL OF TWO LINK MANIPULATOR: 

First we shall calculate the potential energies of the system: 

K=K 1 +K 2 

Where /fj = -m.xi\Q\ (figure 3.1 has been taken as the model) 

To calculate K 2 , we first we will write the position equation for m 2 and then differentiate it for the velocity of m 2 : 

x 2 = h sind 1 + = l2sia(d 1 +6 2 ) = ?iSi + I2S12 

Vi-- '1^1 - I2C12 

x 2 = -i 1 c 1 e 1 + i 2 c 12 (e 1 + e 2 ) 
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y 2 = i 1 s 1 e 1 + i 2 s 12 (e 1 + e 2 ) 

Since V 2 = x 2 + y 2 we get 

V 2 = I 2 6 2 + l 2 (8 2 + 6 2 + 26 r 6 2 ) + 2kl 2 (6 2 + M2X C r C 12 + S^u) 

= i 2 e 2 + i 2 (e 2 + e 2 + ie x e 2 ) + n x i 2 c 2 (e 2 + M2) 

Then the kinetic energy for the second mass is 



K 2 = \m 2 ll 6l + \m 2 [ 2 2 {e 2 + 6 2 + 26\9 2 ) + m 2 h l 2 C 2 (8 2 + 8^) 



Fig 3.1: Two Link Manipulator 

And the total kinetic energy is 

K = -(rn 1 + m 2 ) l 2 8 2 + -m 2 l\{8\ + 8 2 + 29 1 9 2 ) + m 2 li l 2 C 2 {8\ + ^fi^The Potential energy of the system can be 

written as: 

P 1 = - m x gl x C x 

P 2 = -m 2 gliC 1 " m i%h c \i 

p = P 1 +P 2 =-(m 1 + m 2 ) g^Ci - m 2 gl 2 C 12 

Using the Lagrangian technique, the first equation of motion is: 
T 1 = [(m 1 + m 2 )ll +m 2 ll +2m 2 l 1 l 2 C 2 }8\ + [m 2 l\ + m 2 M 2 C 2 ]#2 
2m 2 [ 1 [ 2 S 2 8\8 2 - m^l^el + ( m 1 + m 2 )g l 1 s 1 + gm 2 l 2 S 12 

Similarly, 

T 2 ={m 2 [\ +m 2 l 1 l 2 C 2 )8 1 +m 2 lle 2 + m^^S^ 2 + gm 2 l 2 S 12 

Writing these equations in matrix form 



(m 1 + m 2 )ll +m 2 ll + 2m 2 l x l 2 C 2 m 2 l\ + m 2 i x l 2 C 2 



{m 2 l{ + mj^ZjCj) 

)2 



m 2 li 



I -m-2.hl-2.S-A 6 2 t-m^l^ -m^Z^l e^ 2 \A\ ( , 

\m 2 i 1 i 2 s 2 o \[q2\ + Y o o J[e 2 eJ + LsJ ^ 1J 

Where A = ( m 1 + m 2 )g l 1 S 1 + gm 2 l 2 S 12 

B = gm 2 l 2 S 12 
The torque equations (1) can be expressed in short form as: 

M 11 e 1 + M 12 e 2 + K^e-L, e t , e 2 ) + g^, e 2 ) = T a (3. 2) 

M 21 e t + m 22 g 2 + K 2 (e 2 , 9 V e 2 ) + c 2 (e 1; e 2 ) = t 2 (3. 3) 



G = 



Mil W12] 
M 21 M 22 J 

„ is the terms due to Gravity. 



K 2 \ 



IV. 



STATE VARIABLE MODELING OF TWO LINK MANIPULATOR 



The state vector is defined as x(t) 



r*i] 




rflii 


x 2 
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*3 




e 7 . 


.X4. 




le 2 \ 



rT 

and the control inputs are the torques themselves u(t) — _ 



With H = M the non linear state equations for the two link robot manipulator takes the form: 



*2 

-H ll (K l +G l )-H l2 {K 2 + G 2 ) 

X A 

— #2i(Xi + G{) — H 22 (K 2 + G 2 ) 





#11 H 12 



#21 w 22 



. (4.1) 



In order to linearize the model, it is first noted that the Coriolis and the Centrifugal forces are all quadratic in 
angular velocity, so that for any linearization around a stationary point, i.e. one with 9 10 — 9 20 — 0, these terms disappear. 
Therefore for linearization around X the state variables are: 
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x(t) = x + Ax(t) = 



010 



J 



+ Ax(t) and u(t) = u + Au(t) = L 10 l + Lj^^l (4.2). 



From this the incremental linear state space model is obtained as: Ax(t) — AAx(t) + BAu(t) . 
Where 

1 

- — (tfiiGi+WizGz) - — (HiiGi+tf^) 



.(4.3) 



A = 



de 1 
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"del 









(#21^1 + H22G2) 



de 2 

d 





1 

(.H21G1 + H22G2) 



and B 





Wulo #12 1 



#21 1 #22 1 



. (4.4) 



Output equation will be y — 



Xl 

*3 

Xj\ 



The following numerical data have been taken for simulation purpose 
m 1 — 3kg; l x — 0.6m;J 1 — 0.12kgm 2 ; m 2 — 2.5kg; 
l 2 - 0.8m; J 2 - 0.15kgm 2 ; 
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V. INTRODUCTION TO STATE OBSERVER 

To implement state feedback control [control law is given by u — r — Kx (5.1)] by pole placement, all the 

state variables are required to be feedback. However, in many practical situations, all the states are not accessible for direct 
measurement and control purposes; only inputs and outputs can be used to drive a device whose outputs will approximate the 
state vector. This device (or computer program) is called State Observer. Intuitively the observer should have the similar 
state equations as the original system (i.e. plant) and design criterion should be to minimize the difference between the 
system output y — Cx and the output y = Cx as constructed by the observed state vector x. This is equivalent to 
minimization of x — x. Since x is inaccessible, y — y is tried to be minimized. The difference (y — y) is multiplied by a 
gain matrix (denoted by M) of proper dimension and feedback to the input of the observer. There are two well-known 
observers namely - Luenberger Observer (1964, 1971) and Das & Ghosal Observer (1981). The second one has some 
genuine advantages over the first one. Das & Ghosal Observer construction procedure is essentially based on the Generalized 
Matrix Inverse Theory and Linear space mathematics. 
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Fig 5.1: Observer General Block Diagram 



VI. 



REDUCED ORDER DAS & GHOSAL OBSERVER APPLIED TO TWO LINK 

MANIPULATOR 

Reduced order Das and Ghosal observer is governed by the following equations and conditions. 

x = CBy + L h (6.1) (eqn. 13 of [1]) 

h(t) = L3AL h(t) + L3AC3 y(t) + L^ B u(t) (6.2) (eqn. 15 of [1]) 
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y = CALh + CAC g y + CBu (6.3) (eqn. 18 of [1]) 

R = {L^AL - MCAL)h + {L^AC^ - MCAC3)y + (L 9 - MCB)u + My (6.4) (eqn. 19 of [1]) 

if = (LSAL - MCAL)q + {(L»i4C» - MCACS) + {13 AL - MCAL)M}y + (LS - MCB)u (6.5) (eqn. 20 of [1]) 

where q = h-My (6.6) (Page-374 of [1]) 

And x = Lq + (C3 + LM)y (6.7) (eqn. 21 of [1]) 

VII. COMPOSITE ROBOTIC CONTROLLER DESIGN USING REDUCED ORDER DAS 
& GHOSAL OBSERVER & STATE FEEDBACK & MULTIPLE INTEGRATORS 

Governing Equations: 



1) 


x = Ax + Bui 


2) 


Y = Cx 


3) 


111 = *^i^i — KijX 


4) 


Xi=n-Y 


5) 


q - Aq+But + JY 


6) 


x = Cq + DY 



where A = (LS AL - MCAL); B = {13 - MCB); 
] = {{LSACS - MCACS) + {19 AL - MCAL)M}; 
C = L; D = {C3 + LM); 

Main Features of the Composite Robotic Controller are: 

> 
> 
> 

> 

> 
> 



State Feedback Controller 

Optimal Pole Placement by LQR policy 

Output Feedback 

Reduced Order observer (Das & Ghosal Observer used) 

Multiple Integrators (PI or PID controller can also be used) 

Desired angular Positions specified as Q\ re f & 02ref ■ 



Ref input 1 (Joint 
angle0 lre ^ ) 



Plant 



Output 




Fig 7.1: Block Diagram of Composite Robotic Controller 
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VIII. DISCUSSION AND CONCLUSION 

In this paper a two link robotic manipulator arm, having two joints (one shoulder joint and one elbow joint), has 
been used to move from one point to another point defined by its angular positions (6i& 8 2 ). Reduced order Das & Ghosal 
observer has also been implemented in this application to estimate the two states - angular velocity of joint 1 and angular 
velocity of joint 2. Though these two states can be measured by external sensors but these are being estimated to replace the 
sensors thus saving space and reducing overall weight and cost of the setup. That's why observer has been used and other 
two states i.e. joint rotations can be easily measured by using rotary potentiometer or optical encoder or proximity sensors 
which are much simple to be set up. From the simulation responses (fig 8.1, 8.2, 8.3, 8.4) it is seen that the estimated states 
(indicated by red dotted line) got overlapped with the original states (indicated by blue continuous line) from the very 
beginning without any oscillations or steady state errors. In this simulation, the initial angular positions of the links are taken 
as 8i = 45 & 2 — — 30' respectively and their destination have been considered to be ^ = — 30 & 8 2 = 45'. From the 
results, it can be inferred that the present robotic controller (a combination of state feedback controller, reduced order 
observer, output feedback and multiple integrators) is able to drive and control the two link manipulator system in a very 
efficient and effective manner. So this scheme can be applied to any other robotic system successfully. 

To realize state feedback control all states are required to be fedback. So in practical robotic system also reduced 
order observer can be implemented successfully to estimate the states which are not accessible for direct measurement or 
very difficult to be measured. If all the eigen values of the observer dynamic system are properly chosen in the left half of 's' 
plane then it does not impair the stability of the overall system, it simply add it's own eigen values to the closed loop 
system's eigen values. Also the observer system does not degrade the performance of the original plant. 



Simulation Results: 




Figure 3,1: x\ is riant stats and jdiatGl is estimated stats 
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Figure B.3:x3 is plant stats audxhatGj is sstimatsd stats 
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